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ABSTRACT: 

PURPOSE: To prevent damage by checking the possibility of the 
damage such as 

the breakage of a finger by the operation program of a robot. 
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CONSTITUTION: The Z-axis coordinate of a point P1 is found with 
an 

instruction A=FNC(P1 , 4) and movement to the point P1 is performed 
with an 

instruction MOVE P1 . The Z-axis coordinate of a point P2 is found 
with an 

instruction B=FNC(P2, 4). Here, when A=B, the Z-axis coordinates of 
the points 

P1 and P2 are equal and it is known that the program is normal and 
there is no 

obstacle during the movement. In this case, an instruction MOVE P2 
is 

therefore executed to perform the movement to the point P2. Unless 
A=B, it is 

judged that a wrong program is executed and an instruction STOP is 
executed to 

stop the device. Thus, a function which extracts optional component 
data on 

one optional instruction point is provided and used to check the 
adequacy of 

the instruction point, thereby checking the possibility of breakage in 
advance. 
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r 25 A- FNC {P1,A ) 

- 30 MOVE PI 

35 B=FNC(P2,4) 

36 IF A< > B THEN STOP 
L AO MOVE P2 
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